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ABSTRACT 



Extended Kalman filtering is applied to the PLRS (Position 
Locating Reporting System) . Here the nonlinearity to the 
filter enters through the measurement (range only) . The 
nonlinearity being the relationship between range and the 
cartesian coordinate states of the filter. 

Filter covariances of error are portrayed as error 
ellipsoids. These are used to determine which one should 
be used to update a unit when there are several other 
units available for ranging. One should attempt to make the 
range measurement in the same direction of the major axis of 
error associated with the unit to be updated. 

The filtering techniques are evaluated using static units 
and high speed maneuvering aircraft. 
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I. 



INTRODUCTION 



Position location of tactical elements in the Marine 
Corps in the past has relied upon the fact that these units 
had maps from which they could determine their position. 
Position determination is therefore highly dependent on the 
ability of an individual to correctly orient himself to the 
natural terrain surrounding him and locate this same terrain 
on the map. Once located, the requirement then exists to 
transmit position information via radio link to parent units. 
Meshed with the ground commander's problem of position 
location is the task of organizing and conducting support 
operations such as medical evacuation of wounded personnel, 
artillery, naval gunfire and air support. 

Using visual references it becomes difficult to accurately 
locate one's position when- operating in mountainous terrain, 
in heavy vegetation, at night or in bad weather. And with 
the heavy volume of radio traffic experienced during battle, 
the probability of communicating to higher headquarters a 
unit's position or information about that position is reduced. 
As a result the support operations mentioned earlier are 
delayed because of detailed clearances required to ensure 
protection of friendly units whose position is not precisely 
known . 

The obstacles to position location suggested can and do 
arise in the conduct of actual operations, and for that 
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reason, the Marine Corps has written specifications detailing 
a Position Location and Reporting System (PLRS) designed for 
tactical employment on the battlefield, [1] . The system as 
construed is to consist of a containerized master unit 
composed of a general purpose computer and communications 
control electronics. This unit is referred to as the Master 
Unit. It is responsible for processing all range information 
inputs to the system, and displaying unit positions on a visual 
display with a variety of other information. 

The other units in the area are all portable, capable of 
being carried by a single man, vehicle, or aircraft. They 
are referred to as update or ranging units depending on their 
particular function at the time. When a unit's position is 
being improved, that unit is referred to as the "update" unit. 
All other units that are in contact with the update unit and 
are providing range measurements are "ranging" units. The 
frequency at which each unit is updated is specified according 
to its type. That is, aircraft traveling at much higher 
velocities than men will require updates more often if their 
tracking is to be accurate. 

Before a unit can be tracked and position estimates made, 
an initial estimate of position must be made. This process 
of initialization is controlled by the master unit. Once a 
unit is initialized the computer systematically selects 
ranging units processing their associated range information as 
applicable. In processing range information a new position 
estimate and a measure of the uncertainty in the estimate is 
provided. 
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While the processing of accumulated range information 
for an update unit appears to be straightforward, the 
difficulty lies in deciding which ranges to process so that 
the most accurate position estimates will be obtained. Range 
information is a measurement of the time required to send 
a signal from the ranging unit to the update unit and back 
again plus some built in delays. 

While the measurement of times associated with the total 
time is quite accurate, it is still subject to the effects 
of noise therefore range is a noisy measurement. In addition 
the uncertainty of the ranging unit's position adds to the 
uncertainty of the measurement itself. Therefore the 
selection of a ranging unit to best update a particular unit 
becomes a very important factor in the position location 
problem. One would desire to use the ranging unit nearest 
the line of the major axis of error in the unit to be updated. 

The error ellipsoids of the "update" and "ranging" units 
and their relative geometry are analyzed and their influence 
on the tracking is portrayed in examples with maneuvering 
high speed aircraft and with stationary units. 
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II. POSITION LOCATING PROBLEM 



A. THE FILTER'S DYNAMIC MODEL 
OF AIRCRAFT UNITS 

First consider units in aircraft in a two dimensional 
* 

space. The estimate that we seek in this problem is position 

• • 

(X,Y) and velocity, (X,Y) . X and Y are calculated with 
respect to a relative grid at a point on the earth's surface. 
The altitude is the vertical height above the earth at that 
particular XY grid intersection, and is not utilized in this 
inves tigation . 

For tracking we may choose a fourth order state vector. 



x = 



X 

X 

Y 

Y 



( 1 ) 



Writing the equations in linear state form results in 



x(k+l) = $ x(k) + F w(k) 



(2) 



where 



3 > 



1 T 0 0 

0 10 0 
0 0 1 T 

lO 0 0 1 



(3) 



* 

The altitude tracking will be handled independently. 
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and 




0 T 

B. EXTENDED KALMAN FILTER 

The observable range is a nonlinear function of the 
states. So we must briefly look at how the nonlinearities 
can be handled in this type of problem. 

Consider a nonlinear discrete system of state and 
observation equations given by 

x (k+1) = f(x(k),k) + g(x(k) ,k) -w(k) (5) 



and 



z(k) = h(x(k),k) + v(k) 



(6) 



In these equations f , g and h are nonlinear functions of the 
state variables x, w(k) is plant excitation noise, and v(k) 
is measurement noise. The plant noise and measurement noise 
are assumed uncorrelated, zero-mean, and white. That is 
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E [w (k) • w T ( j ) ] = Q'(k) 6 k j 

and 

E [v (k) • v T (j)] = R (k) S kj 

In order to apply the linear filter equations, (5) and 
(6) are expanded about the best estimate of the state at 
that time and only the first-order terms are kept. Equation 
(5) gives 



x(k+l) = $(k) x(k) + T(k) • w(k) , (7) 



with 



x=x (k) 

Similarly Eq. (6} yields 



8f 

$(k) = — 

3x 



z(k) = H(k) x(k) + v(k) 



( 8 ) 



where 



H (k) 



3h 



3x 



x—x ' (k) 



(9) 



^ t h. 

x(k) is .the estimated state value after the k measurement 

and x' (k) is the predicted value of the state before the 
th 

k measurement. That is. 
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X' (k) 



(10) 



= f (x (k-1) ,k-l) 



A state error vector is defined by 



x(k) = x(k) - x (k) , 



and a predicted state error vector is defined by 



x 1 (k) = x' (k) - x (k) 



The covariance of state error matrix is defined by 



P (k) = E [x (k) • x T (k) ] , 



and the predicted covariance of state error matrix is given 
by 



P'(k) = E[x*(k) • x ,T (k) ] 



The state excitation matrix is given by 



Q (k) = E [T (k) *w(k) *w T (k) •r T (k) ] , 



and the measurement noise covariance matrix is 



R(k) = E[v(k) • v T (k) ] 
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The Kalman Filter equations are given by [2] 



P ' (k+1) = $(k)P(k) $ T (k) + Q(k) (11) 

G (k) = P' (k)H T (k) [H(k)P' (k)H T (k) +R(k)] -1 (12) 

P(k) = [I - G (k) H (k) ] P' (k) (13) 

x' (k) = f(£(k-l),k) (14) 

z' (k) = h (x 1 (k) ,k) (15) 

x (k) = x'(k) +G(k)[z(k) - z ' (k) ] . (16) 



The Q matrix serves not only to allow for maneuvering 
but also to account for any model inaccuracies. That is, 
any discrepancies between the true action of the physical 
system and its characterization by Eq . (7). For a filter 

which reaches steady-state conditions the Q also serves to 
prevent the gain matrix G(k) from approaching zero by always 
insuring uncertainty in the predicted covariance of error 
matrix P 1 (k) . 

The observation equation is nonlinear in the states and 
is given by 



z(k) = [x(k) 2 + y(k) 2 ] 1//2 



(17) 
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Equation (9) can be used to give 
observation matrix. The result is 



H (k) = 



■[ 



x(k) 

x(k) 2 + y(k) 2 



y(k) 

x(k) 2 + y (k) 2 



( 18 ) 



In doing this, the recursive Kalman filter equations have 
been extended to cover the nonlinear case. The pseudo 
measurement matrix, H, must now be calculated from the position 
estimates at each time interval. 

The use of the Extended Kalman technique in tracking a 
unit as it moves through the area presents a unique problem. 
Because we are observing only the range, we can improve our 
estimate of location only along the direction of the range 
vector. That is, the uncertainty or error variance in location 
remains unchanged in cross-range. We must then choose another 
ranging unit nearby that will improve upon this cross range 
error. This however is done later at the next prescribed 
interval for update of the unit in question. 

The conclusion drawn from this observation is that it is 
critical that an algorithm be developed for selecting the 
best observations (ranging units) to process in the updating 
of a unit. It will be shown that this algorithm must be 
dependent on the physical geometry associated with the 
covariance error ellipses . It takes into consideration the 
error covariances associated with both the update and ranging 
units . 
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III. RANGE MEASUREMENT PROCESSING AND ERROR ELLIPSOIDS 



The position of each unit within the system is established 
with a degree of uncertainty about the estimate. This 
uncertainty is expressed in the covariance of error matrix, 

P, and represents the sigma squared error deviation about the 
estimate. The position diagonal terms (P-^i an< ^ P 33^ t ^ e 
covariance matrix represent the variances of the estimate in 
the XY coordinate directions. Their respective off diagonal 
terms (covariances) represent the degree of coupling and the 
orientation of the uncertainty in the XY plane. 

If the errors were normally distributed, there exists a 
rotated coordinate system such that in the new system the 
orthogonal position components are uncorrelated. This is 
equivalent to taking the exponent of the joint normal 
probability density function, and applying a coordinate 
transformation which eliminates the cross terms. 

The exponent (for zero-mean random variables) is 




2r xy 
xv 



o a 
x y 




(19) 



When set equal to a constant, this curve, which is an ellipse, 
is a curve of constant probability. This ellipse does not 
have its major and minor axes aligned with the coordinate 
system however. By applying the transformation 
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x' 



x cos 0 + y sin 0 



( 20 ) 



and 



y' = y cos 0 - x sin 0 



with 



( 21 ) 



0 



1 

2 



tan 



2 cov(x,y) 




( 22 ) 



the ellipse will be aligned with the x' , y' axis and the 
resultant random variables will be uncorrelated. The new 
variances in this system are calculated by 



2 



o 

X 



I 




cov (xy) 
sin 20 ' 



( 23 ) 



and 





cov (xy) 
sin 20 



( 24 ) 



This method of viewing the sample statistics provides insight 

into the filter performance because it shows the regions of 

high probability and their geometric relationships. The 
2 . _ 2 



values of 



x' 



and 



o , 

y 



are referred to as the rotated 



error variances in the following section. 
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When a range measurement is made between two units, each 
with a different and independent error ellipse, the uncertainty 
of position along the range line connecting the two is improved 
for both units. In addition, it is sometimes possible to 
reduce the error of the axis orthogonal to the range line 
depending on the orientation of the error ellipse. 

To study the influence of the error ellipsoids of the 
ranging and update unit let us consider a static example. 

This model is synomymous with those used for foot soldiers. 

Measurement noise will be considered to come solely from 
the error variance of the ranging unit and vice versa when 
their roles interchanged. That is, at the same time the 
"update" unit is being updated, let us also update the 
"ranging" unit. The estimates of position and their error 
ellipsoids are shown in Fig. 1. 

A projection of the error ellipsoid along the y-axis 
is given in Fig. 2. If one utilizes each as an observation 
to update the other, the resulting variance of both along 
the range line is given by 




where and a 2 are the standard deviations of units 1 and 2 
in the range projection and a is the new updated standard 

deviation for both units in the range projection (a ^.) • as 
is seen also in Fig. 2. 
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FIGURE 1. Error ellipsoids for two fixed units displaced 
along y-axis 15 KM 
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FIGURE 2. Projection of error ellipsoids to their x-y 

components and updated error ellipsoids after 
each unit ranges on the other 
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Thus the processing of an error free measurement between 
two units provides a better statistical description of both 
units along the range line. 

This discussion considered fixed units with no velocity 
and only in the XY plane. Central to the equations employed 
in the Kalman filter are equations calculating the gains and 
the error covariance matrix. By merely adding the component 
of the variance of the ranging unit along the range line to 
the measurement noise in the calculation of the Kalman gains, 
the Kalman filter reduces the covariance matrix of the update 
unit properly. 

The uncoupled error matrices and their directions are 
(from eqs . (22) -(24)) 



P 



1 



4 

0 



0 

100 



and 



P 



2 



100 

0 



0 

4 




-30° 



e 2 = +30° 



After update the resulting covariances are (see Fig. 2) 



P^ (new) 



11.42 11.18 

11.18 20.46 
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and 



? 2 (new) 



59.42 

30.34 



30.34 

20.46 



Their uncoupled equivalents 



P^ ' (new) 



3.89 0 

0 28 



and 



P 2 ' (new) 



7.6 0 

0 3.89 



0^ (new) 



0 2 (new) 



After ten updating operations 



P^ (new) = 



P 2 ' (new) = 



5.33 0.02 

0.02 0.04 

14.52 0.06 

.06 0.04 



and their uncoupled equivalents 



P^ 1 (new) 



5.34 0 

0 .08 



0^ 1 (new) 



- 34 ° 



28 . 6 ° 



= 0 . 47 ° 



23 



14.6 



0 




0 



079 



&2 ' (new) 



0.46° 



In Fig. 3 we see the influence of the sequential 
• updating of the units , one upon the other over ten 
observations . 

Note that the successive ranging in the y-direction 
effectively reduced the error variance in y and its 
projection in x due to the xy covariance. This was 
accomplished by assuming the measurement noise consists 
solely of the y component of the error variance of the 
other unit ranging upon it. 
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p yv 




FIGURE 3. Sequential updating of the units, one upon the 
other, over ten observations 
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IV. TRACKING AND MANEUVERING TARGETS 



A. THE CHOICE OF Q 

One possible approach in designing a filter to accomodate 
maneuvers is to increase the random forcing excitation 
covariance, Q, until the filter adequately tracks the 
contemplated maneuvers. Normally this is done in a tracking 
simulation program. The running filter error residual, 

A 

(x(k) - x(k/k) ) appears to be a better indicator of effec- 
tiveness than either mean error 

k 

Mean Error = ^ £ (x(j) - x(j/j)) 

j=l 

or for that matter, error variance. Filter lag or bias as 
is best seen in the sign of the error, is lost in the 
squaring process for the variance. Also, the mean and 
variance error entail an accumulation of all error from 
start up to the present time. In a simulation, a maneuver 
may often not occur until well into a tracking run, and its 
effect may not appear as markedly in the mean error and error 
variance. A Monte Carlo simulation is often an effective 
design tool here. However, unless considerable engineering 
insight is used the resulting filter has been designed to 
handle the zero mean maneuver. That is, the filter will be 
designed against ah ensemble of maneuvering tracks the mean 
of which is no maneuver at all. It appears that a more 
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successful procedure is to design against a highly probable 
worst case maneuver. The resulting filter should then be 
able to handle all possible contingencies, which is a 
necessary ingredient in most military systems. 

The price paid in having a rather high Q in a filter 
design is an increased degradation in filter performance due 
to the measurement noise variance, R. In this application 
the measurement noise is minimal. The important thing is 
to attempt range measurements along the axis of maximum 
filter error variance as discussed in Section III. 

B. SIMULATION RESULTS 

An aircraft flying at Mach 1 follows a turn of radius 
10 KM. Ranging unit 1 is located at the origin. Unit 2 
is placed at (10 KM, 10 KM) . We have the below filter 
parameters for Figs. 4 through 11 are 

10 0 
10 0 
Oil ' 

0 0 1 

0.5 0 

1 0 

0 0.5 

0 1 
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and the initial conditions of 



10 4 0 0 
0 10 -4 0 



0 



0 



P(l/0) 



-4 



0 0 10 



0 



0 0 0 10 



-4 



and 



X(l) = X ( 1/0 ) 



0 

0.333 KM/S 
10 KM 
0 



In Fig. 4 we have the first attempt at the algorithm 
for choosing the ranging unit nearest the line generated 
from the major axis of error in the error ellipsoid of the 
tracker. It ranged solely on unit 2 and failed to follow 
the turn. Similarly in Fig. 5, the filter ranged on unit 2 
for the first half of the flight and on unit 1 for the 
second half. 

The evolution of the design of the filter is presented 
here so that the errors in the design process may help to 
give insight into the filter's performance. 

In Fig. 6 we see the beginning of proper functioning of 
the ranging algorithm (except on the last 20 observations) . 
Note also that the covariance of excitation, Q, is insuf- 
ficient to follow the maneuver as is indicated by the bias 
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in the filter track from the true track. Here we have 



q 11 /R = 2.5 x 10 



from 



R = 0.1 



and 





~.25xl0“ 4 


. 5xl0 -4 


0 


0 




.5xl0~ 4 


-4 

1x10 


0 


0 




0 


0 


. 25xl0~ 4 


.5x10 




0 


0 


.5xl0“ 4 


1x10“ 



In Fig. 7 the algorithm appears to be functioning 
properly and there is sufficient Q for the filter to follow 
the turn. Here we have 

q^/R - 0.25 

In Fig. 8 the filter was tested for its response to 
increasing the measurement noise (from o v = 0.01 KM to 
c v = 0.1 KM) . It tracked well. However in Fig. 9, when 
the noise was again increased (a = 1 KM) the track was lost 
immediately. This gives one a ball-park indication of filter 
performance as the ranging observations are degraded. 
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Figure 10 shows the filter performance with the error 
ellipsoids superimposed at every fifth observation. It 
indicates a short malfunction of the switching algorithm 
when the track crosses the x-axis. This was corrected in 
Fig. 11. The error ellipsoids are expanded to twenty-five 
times their true value in order that they may be seen. 

In the appendix we have listed the computer simulation 
program with comments regarding its operation. 
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FIGURE 4. Aircraft in circular track at Mach 1 and radius 
10 KM. Filter ranging only on unit #2. 
x = true track, o = noise track, + = filter track 
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FIGURE 5. Aircraft in circular track at Mach 1 and radius 
10 KM. Filter ranging on unit #2 and unit #1 
during second half. 

x = true track, □ = noise track, + = filter track 
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FIGURE 6. Aircraft in circular track at Mach 1 and radius 

10 KM. Algorithm for choosing which ranging unit 
working poorly in last third of flight (unit #1 
ranges solely on last 20 observations. A too low 
Q is indicated by the track bias . 

x = true track, □ = noise track, + = filter track 
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FIGURE 7. Aircraft in circular track at Mach 1 and radius 
10 KM. Algorithm for choosing which ranging 
unit working. Q sufficient to allow filter to 
adequately track the turning maneuver. Measurement 
noise = 10 M. 

x = true track, o = noise track, + = filter track 
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FIGURE 8. Aircraft in circular track at Mach 1 and radius 
10 KM. Algorithm for choosing which ranging 
unit working. Q sufficient to allow filter to 
adequately track the turning maneuver. 

Measurement noise = 100 M. 

x = true track, □ = noise track, + = filter track 
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FIGURE 9. Aircraft in circular track at Mach 1 and radius 
10 KM. Algorithm for choosing which ranging 
unit working. Q sufficient to allow filter to 
adequately track the turning maneuver. Filter 
drops track. Measurement noise = 1 KM. 
x = true track, □ = noise track, + = filter track 
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FIGURE 10 . Aircraft in circular track at Mach 1 and radius 
of 10 KM. Error ellipsoids presented on every 
fifth observation. Measurement noise = 10 M. 
Switching algorithm fails on x-axis. Ellipses 
25 times true scale. 

x = true track, o = noise track, + = filter track 
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FIGURE 11. Aircraft in circular track at Mach 1 and radius 
of 10 KM. Switching algorithm corrected. 

Ellipses 20 times true scale. 

x = true track, □ = noise track, + = filter track 
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V. CONCLUSIONS 



The evolution of this filter design appears to have 
some merit. The maneuvering target can be tracked handily 
with adequate choice of Q. The filter operated well in all 
but impossible ranging noise situations. The real system 
has range noise on the order of ten meters. The filter tracked 
well with a range noise sigma of one hundred meters. 

The algorithm for choosing which unit to link to for 
ranging is finally operating satisfactorily. In fact, this 
may be the real contribution of this work. Another possible 
benefit is the use of graphical presentation of the error 
ellipsoids in filter evaluation. They were most essential 
in the algorithm for choosing ranging links and in the Q 
evaluation . 

Still to be accomplished are: an initialization algorithm, 

a spurious data gating scheme and a track deletion logic. 

The latter two items may be dispatched readily by letting 



and if a unit receives no range update. Within the gate 
for, say, six update sequence times, then reinitialize and 
start over. 

The rotation and reduction of the error ellipsoids (i.e. 
the filter error covariance) was most instructive and gave 
much insight into the performance of the filter. 



Gate (k) 
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FILTER FOR STATIC UNITS TRACKING 
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